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FIGS 



PID CONTROL COMPUTATION BLOCK 





S132 


PROPORTIONAL COMPUTATION (P) 
Fb-p = KpAV 




S134 


INTEGRAL COMPUTATION (I) 
Fb-i = KiX AV 




SI 36 


DIFFERENTIAL COMPUTATION (D) 
Fb-d = Kd dAV 
dt 




SI 38 


COMPUTE CONTROL VALUE 
Fb = Fb-p+Fb-i+Fb-d 


N 




Q END OF BLOCK ^ 
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DOWNSLOPE GRADIENT (° ) 






0 


5 


10 


15 


20 


25 


30 




0 


0 


35 


40 


45 


50 


60 


70 




20 


0 


40 


45 


50 


55 


65 


75 


40 


0 


45 


50 


55 


60 


70 


80 


LOAD 


60 


0 


50 


55 


60 


65 


75 


85 


80 


0 


55 


60 


65 


70 


80 


90 




100 


0 


65 


70 


75 


80 


90 


100 



FIG. 7 



( START ) 





S200 








READ STATUS OF LOAD SETTING SWITCH 




NOT CHANGED 



CHANGED 



S210 



SET PARAMETERS CORRESPONDING TO STATUS OF LOAD SETTING SWITCH 



S215 



READ STATUS OF DOWNSLOPE GRADIENT SETTING SWITCH 




NOT CHANGED 



CHANGED 



S225 



SET PARAMETERS CORRESPONDING TO STATUS OF DOWNSLOPE 
GRADIENT SETTING SWITCH 



S230 



READ STATUS OF TARGET SPEED SETTING SWITCH 




NOT CHANGED 



CHANGED 



8240 



MODIFY TARGET SPEED CORRESPONDING TO STATUS OF TARGET SPEED 
SETTING SWITCH 



8245 



READ VEHICLE SPEED SENSOR VALUE Vr 



I 



8250 



COMPUTE DIFFERENCE A V BETWEEN TARGET SPEED Vt AND VEHICLE SPEED 
SENSOR VALUE Vr 



8255 



COMPUTE CONTROL VALUE Fb WITH PID CONTROL 



8260 



ADD PROPORTIONAL VALVE OFFSET OUTPUT VALUE 



8270 



OUTPUT CONTROL VALUE Fb TO SOLENOID PROPORTIONAL VALVE 
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FIG. 12 



( START ) 




READ MILEAGE L FROM 
DISTANCE SENSOR 
AND SET IT AS INITIAL 
VALUE LO 



READ MILEAGE L FROM 
DISTANCE SENSOR AND 
OBTAIN RELATIVE 
DISTANCE AL=L-LO 



S320 



SET MEMORY COUNTER 
TO 0 FOR RESETTING OF 
TAUGHT DATA STORAGE 
AREA IN MEMORY 




READ STATUS OF DOWNSLOPE 
GRADIENT SWITCH AND SET 
DOWNSLOPE GRADIENT 6 
CORRESPONDING TO SWITCH 
STATUS 



S360 



READ STATUS OF CURVE 
SWITCH AND SET CURVE 
ANGLE 01 CORRESPONDING 
TO SWITCH STATUS 



INCREMENT MEMORY COUNTER 
BY +1 AND STORE A L, 6. a 
IN CORRESPONDING TAUGHT 
DATA STORAGE LOCATIONS 
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( START ) 




INCREMENT REPRODUCTION 
COUNTER BY +1 AND READ 
TAUGHT DATA A L. 0 , a 
AT CORRESPONDING 
MEMORY COUNTER VALUE 



S435 



SET PARAMETERS CORRESPOND- 
ING TO TAUGHT DATA AL, 6, a 



S440 



READ VEHICLE SPEED 
SENSOR VALUE Vr 



S445 



COMPUTE DIFFERENCE AV 
BETWEEN TARGET SPEED Vt 
AND VEHICLE SPEED SENSOR 
VALUE Vr 



S450 



COMPUTE CONTROL VALUE 
Fb WITH PID CONTROL 



S455 



ADD PROPORTIONAL VALVE 
OFFSET OUTPUT VALUE 



S460 



OUTPUT CONTROL VALUE Fb TO 
SOLENOID PROPORTIONAL VALVE 
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FIG. 16 



( START ) 




READ MILEAGE L FROM 
DISTANCE SENSOR 
AND SET IT AS INITIAL 
VALUE LO 



READ MILEAGE L FROM 
DISTANCE SENSOR AND 
OBTAIN RELATIVE 
DISTANCE AL=L-LO 



S320 



SET MEMORY COUNTER 
TO 0 FOR RESETTING OF 
TAUGHT DATA STORAGE 
AREA IN MEMORY 




S350A 



READ DOWNSLOPE GRADIENT 6 
FROM DOWNSLOPE GRADIENT 
SENSOR 



S360A 



READ CURVE ANGLE a FROM 
STEERING ANGLE SENSOR 



S370 



INCREMENT MEMORY COUNTER 
BY +1 AND STORE A L, 0 . a 
IN CORRESPONDING TAUGHT 
DATA STORAGE LOCATIONS 
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FIG. 19 



( START ) 




READ POSITION INFORMA- 
TION P FROM GLOBAL 
COORDINATE POSITION 
SENSOR AND SET IT AS 
INITIAL VALUE LO 



S320 



SET MEMORY COUNTER 
TO 0 FOR RESETTING OF 
TAUGHT DATA STORAGE 
AREA IN MEMORY 



READ POSITION INFORMA- 
TION P FROM GLOBAL 
COORDINATE POSITION 
SENSOR AND OBTAIN 
DISTANCE DEVIATION AP 
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S350A 



READ DOWNSLOPE GRADIENT 6 
FROM DOWNSLOPE GRADIENT 
SENSOR 



S360A 



READ CURVE ANGLE a FROM 
STEERING ANGLE SENSOR 



S370B 



INCREMENT MEMORY COUNTER 
BY +1 AND STORE AP, 6, a 
IN CORRESPONDING TAUGHT 
DATA STORAGE LOCATIONS 
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FIG.20 



( START ) 




READ POSITION INFORMATION 
FROM GLOBAL COORDINATE 
POSITION SENSOR AND SET IT 
AS INITIAL VALUE PC 
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SET REPRODUCTION COUNTER 
TO 0 



READ POSITION INFORMATION P 
FROM GLOBAL COORDINATE 
POSITION SENSOR AND OBTAIN 
DISTANCE DIFFERENCE AP 




INCREMENT REPRODUCTION 
COUNTER BY +1 AND READ 
TAUGHT DATA AP.0. Of 
AT CORRESPONDING 
MEMORY COUNTER VALUE 
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SET PARAMETERS CORRESPOND- 
ING TO TAUGHT DATA AP, d, a 



S440 



READ VEHICLE SPEED 
SENSOR VALUE Vr 



S445 



COMPUTE DIFFERENCE AV 
BETWEEN TARGET SPEED Vt 
AND VEHICLE SPEED 
SENSOR VALUE Vr 



S450 



COMPUTE CONTROL VALUE 
Fb WITH PID CONTROL 



S455 



ADD PROPORTIONAL VALVE 
OFFSET OUTPUT VALUE 



S460 



OUTPUT CONTROL VALUE Fb TO 
SOLENOID PROPORTIONAL VALVE 
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